home *** CD-ROM | disk | FTP | other *** search
/ HAM Radio 3.2 / Ham Radio Version 3.2 (Chestnut CD-ROMs)(1993).ISO / packet / n17jsrc / ppp.c < prev    next >
C/C++ Source or Header  |  1991-06-26  |  23KB  |  896 lines
  1. /*
  2.  *  PPP.C    -- Send and receive datagrams on serial lines with
  3.  *           Point-to-Point Protocol
  4.  *
  5.  *    This implementation of PPP is declared to be in the public domain.
  6.  *
  7.  *    Based (in part) upon previous implementations by:
  8.  *    1989    -- Drew Daniel Perkins        (ddp@andrew.cmu.edu)
  9.  *           Carnegie Mellon University
  10.  *    09-90    -- Katie Stevens        (dkstevens@ucdavis.edu)
  11.  *           UC Davis, Computing Services
  12.  *
  13.  *    Jan 91    Bill_Simpson@um.cc.umich.edu
  14.  *        Computer Systems Consulting Services
  15.  *
  16.  *    Feb 91    Glenn McGregor            (ghm@merit.edu)
  17.  *        Testing and suggestions.
  18.  *
  19.  *    May 91    Bill Simpson & Glenn McGregor
  20.  *        Update to newest draft RFCs.
  21.  *        Add support for echo and discard message sending.
  22.  *        PAP prompt for password only when fails (allow missing password).
  23.  */
  24.  
  25. #include <stdio.h>
  26. #include <time.h>
  27. #include "global.h"
  28. #include "mbuf.h"
  29. #include "timer.h"
  30. #include "proc.h"
  31. #include "iface.h"
  32. #include "internet.h"
  33. #include "ip.h"
  34. #include "slhc.h"
  35. #include "8250.h"
  36. #include "asy.h"
  37. #include "pktdrvr.h"
  38. #include "socket.h"
  39. #include "devparam.h"
  40. #include "ppp.h"
  41. #include "pppfsm.h"
  42. #include "ppplcp.h"
  43. #include "pppipcp.h"
  44. #include "ppppap.h"
  45. #include "trace.h"
  46.  
  47. /* Routines local to this file */
  48. static struct mbuf *htonppp __ARGS((struct ppp_hdr *ppp, struct mbuf *data));
  49.  
  50. static void ppp_log __ARGS((struct ppp_s *ppp_p, char *comment));
  51. static void ppp_in_error __ARGS((struct ppp_s *ppp_p, struct mbuf *bp, char *comment));
  52. static void ppp_out_error __ARGS((struct ppp_s *ppp_p, struct mbuf *bp, char *comment));
  53. static void ppp_unknown __ARGS((struct ppp_s *ppp_p, struct mbuf *bp, char *comment));
  54.  
  55. static int ppp_raw __ARGS((struct iface *iface, struct mbuf *data));
  56.  
  57. static void ppp_queue __ARGS((struct ppp_s *ppp_p, struct mbuf *bp, int16 negotiated));
  58. static void ppp_recv __ARGS((int dev, void *p1, void *p2));
  59. static int ppp_iostatus __ARGS((struct iface *ifp, int command, int32 value));
  60. static void ppp_machine __ARGS((int dev, void *p1, void *p2));
  61.  
  62.  
  63. /*
  64.  * FCS lookup table as generated by fcsgen.c
  65.  */
  66. int16 fcstab[256] = {
  67.     0x0000, 0x1189, 0x2312, 0x329b, 0x4624, 0x57ad, 0x6536, 0x74bf,
  68.     0x8c48, 0x9dc1, 0xaf5a, 0xbed3, 0xca6c, 0xdbe5, 0xe97e, 0xf8f7,
  69.     0x1081, 0x0108, 0x3393, 0x221a, 0x56a5, 0x472c, 0x75b7, 0x643e,
  70.     0x9cc9, 0x8d40, 0xbfdb, 0xae52, 0xdaed, 0xcb64, 0xf9ff, 0xe876,
  71.     0x2102, 0x308b, 0x0210, 0x1399, 0x6726, 0x76af, 0x4434, 0x55bd,
  72.     0xad4a, 0xbcc3, 0x8e58, 0x9fd1, 0xeb6e, 0xfae7, 0xc87c, 0xd9f5,
  73.     0x3183, 0x200a, 0x1291, 0x0318, 0x77a7, 0x662e, 0x54b5, 0x453c,
  74.     0xbdcb, 0xac42, 0x9ed9, 0x8f50, 0xfbef, 0xea66, 0xd8fd, 0xc974,
  75.     0x4204, 0x538d, 0x6116, 0x709f, 0x0420, 0x15a9, 0x2732, 0x36bb,
  76.     0xce4c, 0xdfc5, 0xed5e, 0xfcd7, 0x8868, 0x99e1, 0xab7a, 0xbaf3,
  77.     0x5285, 0x430c, 0x7197, 0x601e, 0x14a1, 0x0528, 0x37b3, 0x263a,
  78.     0xdecd, 0xcf44, 0xfddf, 0xec56, 0x98e9, 0x8960, 0xbbfb, 0xaa72,
  79.     0x6306, 0x728f, 0x4014, 0x519d, 0x2522, 0x34ab, 0x0630, 0x17b9,
  80.     0xef4e, 0xfec7, 0xcc5c, 0xddd5, 0xa96a, 0xb8e3, 0x8a78, 0x9bf1,
  81.     0x7387, 0x620e, 0x5095, 0x411c, 0x35a3, 0x242a, 0x16b1, 0x0738,
  82.     0xffcf, 0xee46, 0xdcdd, 0xcd54, 0xb9eb, 0xa862, 0x9af9, 0x8b70,
  83.     0x8408, 0x9581, 0xa71a, 0xb693, 0xc22c, 0xd3a5, 0xe13e, 0xf0b7,
  84.     0x0840, 0x19c9, 0x2b52, 0x3adb, 0x4e64, 0x5fed, 0x6d76, 0x7cff,
  85.     0x9489, 0x8500, 0xb79b, 0xa612, 0xd2ad, 0xc324, 0xf1bf, 0xe036,
  86.     0x18c1, 0x0948, 0x3bd3, 0x2a5a, 0x5ee5, 0x4f6c, 0x7df7, 0x6c7e,
  87.     0xa50a, 0xb483, 0x8618, 0x9791, 0xe32e, 0xf2a7, 0xc03c, 0xd1b5,
  88.     0x2942, 0x38cb, 0x0a50, 0x1bd9, 0x6f66, 0x7eef, 0x4c74, 0x5dfd,
  89.     0xb58b, 0xa402, 0x9699, 0x8710, 0xf3af, 0xe226, 0xd0bd, 0xc134,
  90.     0x39c3, 0x284a, 0x1ad1, 0x0b58, 0x7fe7, 0x6e6e, 0x5cf5, 0x4d7c,
  91.     0xc60c, 0xd785, 0xe51e, 0xf497, 0x8028, 0x91a1, 0xa33a, 0xb2b3,
  92.     0x4a44, 0x5bcd, 0x6956, 0x78df, 0x0c60, 0x1de9, 0x2f72, 0x3efb,
  93.     0xd68d, 0xc704, 0xf59f, 0xe416, 0x90a9, 0x8120, 0xb3bb, 0xa232,
  94.     0x5ac5, 0x4b4c, 0x79d7, 0x685e, 0x1ce1, 0x0d68, 0x3ff3, 0x2e7a,
  95.     0xe70e, 0xf687, 0xc41c, 0xd595, 0xa12a, 0xb0a3, 0x8238, 0x93b1,
  96.     0x6b46, 0x7acf, 0x4854, 0x59dd, 0x2d62, 0x3ceb, 0x0e70, 0x1ff9,
  97.     0xf78f, 0xe606, 0xd49d, 0xc514, 0xb1ab, 0xa022, 0x92b9, 0x8330,
  98.     0x7bc7, 0x6a4e, 0x58d5, 0x495c, 0x3de3, 0x2c6a, 0x1ef1, 0x0f78
  99. };
  100.  
  101. #define pppfcs(fcs, c)        ((fcs >> 8) ^ fcstab[(fcs ^ c) & 0x00ff])
  102. #define SP_CHAR            0x20
  103.  
  104. /* actions for incoming bytes */
  105. enum {
  106.     modeTOSS,
  107.     modeESCAPED,
  108.     modeNORMAL
  109. };
  110.  
  111. /****************************************************************************/
  112.  
  113. /* Convert PPP header in host form to network form */
  114. static struct mbuf *
  115. htonppp(ppp, data)
  116. struct ppp_hdr *ppp;
  117. struct mbuf *data;
  118. {
  119.     struct mbuf *bp;
  120.     register char *cp;
  121.  
  122.     /* Prepend header onto packet data */
  123.     if ((bp = pushdown(data, PPP_HDR_LEN)) == NULLBUF)
  124.         return NULLBUF;
  125.  
  126.     /* Load header with proper values */
  127.     cp = bp->data;
  128.     *cp++ = ppp->addr;
  129.     *cp++ = ppp->control;
  130.     cp = put16(cp,ppp->protocol);
  131.  
  132.     return bp;
  133. }
  134.  
  135. /* Extract PPP header from incoming packet */
  136. int
  137. ntohppp(ppp, bpp)
  138. struct ppp_hdr *ppp;
  139. struct mbuf **bpp;
  140. {
  141.     ppp->addr = PULLCHAR(bpp);
  142.     ppp->control = PULLCHAR(bpp);
  143.     ppp->protocol = pull16(bpp);
  144.     return(PPP_HDR_LEN);
  145. }
  146.  
  147.  
  148. /************************************************************************/
  149. /* General log routine */
  150. static void
  151. ppp_log( ppp_p, comment )
  152. struct ppp_s *ppp_p;
  153. char *comment;
  154. {
  155.     if (ppp_p->trace)
  156.         log(-1,"%s: PPP %s",
  157.             ppp_p->iface->name,
  158.             comment);
  159. }
  160.  
  161.  
  162. /* Bad Input packet */
  163. static void
  164. ppp_in_error(ppp_p, bp, comment)
  165. struct ppp_s *ppp_p;
  166. struct mbuf *bp;
  167. char *comment;
  168. {
  169.     ppp_p->InError++;
  170.     free_p(bp);
  171.     ppp_log( ppp_p, comment );
  172. }
  173.  
  174.  
  175. /* Bad output packet */
  176. static void
  177. ppp_out_error(ppp_p, bp, comment)
  178. struct ppp_s *ppp_p;
  179. struct mbuf *bp;
  180. char *comment;
  181. {
  182.     ppp_p->OutError++;
  183.     free_p(bp);
  184.     ppp_log( ppp_p, comment );
  185. }
  186.  
  187.  
  188. /* Unknown type input packet */
  189. static void
  190. ppp_unknown(ppp_p, bp, comment)
  191. struct ppp_s *ppp_p;
  192. struct mbuf *bp;
  193. char *comment;
  194. {
  195.     struct ipcp_s *ipcp_p;
  196.  
  197.     if ( (ipcp_p = ppp_p->fsm[IPcp].pdv) != NULL ) {
  198.         slhc_toss( ipcp_p->slhcp );
  199.     }
  200.     ppp_in_error( ppp_p, bp, comment );
  201. }
  202.  
  203.  
  204. /****************************************************************************/
  205. /* Send IP datagram with Point-to-Point Protocol */
  206. int
  207. ppp_send(bp,iface,gateway,prec,del,tput,rel)
  208. struct mbuf *bp;    /* Buffer to send */
  209. struct iface *iface;    /* Pointer to interface control block */
  210. int32 gateway;        /* Ignored (PPP is point-to-point) */
  211. int prec;
  212. int del;
  213. int tput;
  214. int rel;
  215. {
  216.     struct ppp_s *ppp_p;
  217.     struct ipcp_s *ipcp_p;
  218.     int protocol = PPP_IP_PROTOCOL;
  219.  
  220.     if (iface == NULLIF
  221.      || (ppp_p = iface->extension) == NULL) {
  222.         free_p(bp);
  223.         return -1;
  224.     }
  225.  
  226.     if (ppp_p->fsm[IPcp].state != fsmOPENED) {
  227.         ppp_out_error( ppp_p, bp, "not open for IP traffic" );
  228.         return -1;
  229.     }
  230.  
  231.     ipcp_p = ppp_p->fsm[IPcp].pdv;
  232.     if (ipcp_p->remote.work.negotiate & IPCP_N_COMPRESS) {
  233.         /* Attempt IP/TCP header compression */
  234.         switch ( slhc_compress(ipcp_p->slhcp, &bp,
  235.             ipcp_p->remote.work.slot_compress) ) {
  236.         case SL_TYPE_IP:
  237.             protocol = PPP_IP_PROTOCOL;
  238.             break;
  239.         case SL_TYPE_COMPRESSED_TCP:
  240.             protocol = PPP_COMPR_PROTOCOL;
  241.             break;
  242.         case SL_TYPE_UNCOMPRESSED_TCP:
  243.             protocol = PPP_UNCOMP_PROTOCOL;
  244.             break;
  245.         default:
  246.             ppp_out_error( ppp_p, bp, "bad IP packet" );
  247.             return -1;
  248.         };
  249.     }
  250.     ppp_p->OutIP++;
  251.     return (*iface->output)(iface,NULLCHAR,NULLCHAR,protocol,bp);
  252. }
  253.  
  254.  
  255. /* Send a packet with PPP header */
  256. int
  257. ppp_output(iface,dest,source,protocol,data)
  258. struct iface *iface;    /* Pointer to interface control block */
  259. char *dest;        /* Dest addr (ignored; PPP is point-to-point) */
  260. char *source;        /* Source addr (ignored; PPP is point-to-point) */
  261. int16 protocol;        /* PPP Protocol Type field */
  262. struct mbuf *data;    /* Actual data to be sent */
  263. {
  264.     struct ppp_s *ppp_p;
  265.     struct mbuf *bp;
  266.     struct ppp_hdr hdr;
  267.  
  268.     if (iface == NULLIF
  269.      || (ppp_p = iface->extension) == NULL) {
  270.         free_p(data);
  271.         return -1;
  272.     }
  273.  
  274.     if (ppp_p->phase == pppDEAD) {
  275.         ppp_out_error( ppp_p, data, "line not up" );
  276.         return -1;
  277.     }
  278.  
  279.     hdr.addr = HDLC_ALL_ADDR;
  280.     hdr.control = HDLC_UI;
  281.     hdr.protocol = protocol;
  282.  
  283.     if ((bp = htonppp(&hdr, data)) == NULLBUF) {
  284.         ppp_out_error( ppp_p, data, Nospace );
  285.         return -1;
  286.     }
  287.  
  288.     return (*iface->raw)(iface,bp);
  289. }
  290.  
  291.  
  292. /* Encode a raw packet in PPP framing, put on link output queue */
  293. static int
  294. ppp_raw(iface,bp)
  295. struct iface *iface;
  296. struct mbuf *bp;
  297. {
  298.     struct ppp_s *ppp_p = iface->extension;
  299.     struct lcp_s *lcp_p = ppp_p->fsm[Lcp].pdv;
  300.     struct mbuf *hbp;
  301.     struct ppp_hdr hdr;
  302.     int full_lcp, full_ac, full_p;
  303.     int16 calc_fcs = HDLC_FCS_START;
  304.     int32 accm = LCP_ACCM_DEFAULT;
  305.     int len = PPP_HDR_LEN;
  306.     register char *cp;
  307.     register int c;
  308.  
  309.     dump(iface,IF_TRACE_OUT,CL_PPP,bp);
  310.     iface->rawsndcnt++;
  311.     iface->lastsent = secclock();
  312.  
  313.     /* Get the HDLC/PPP header */
  314.     ntohppp(&hdr, &bp);
  315.  
  316.     if ( ( full_lcp = (hdr.protocol == PPP_LCP_PROTOCOL) ) == 0
  317.      && (lcp_p->remote.work.negotiate & LCP_N_ACCM) ) {
  318.         accm = lcp_p->remote.work.accm;
  319.     }
  320.  
  321.     if ( ( full_p = ( full_lcp
  322.             ||  !(lcp_p->remote.work.negotiate & LCP_N_PFC)
  323.             ||  hdr.protocol > 0x00ff ) )
  324.         == 0 ) {
  325.         --len;
  326.     }
  327.  
  328.     /* Discard HDLC address and control fields if possible */
  329.     if ( ( full_ac = ( full_lcp
  330.             ||  !(lcp_p->remote.work.negotiate & LCP_N_ACFC)
  331.             ||  ( !full_p
  332.                 &&  hdr.protocol == HDLC_ALL_ADDR
  333.                 &&  *bp->data == HDLC_UI ) ) )
  334.         == 0 ) {
  335.         len -= 2;
  336.     }
  337.  
  338.     /* Prepend header onto packet data */
  339.     if ((hbp = pushdown(bp, len)) == NULLBUF) {
  340.         ppp_out_error( ppp_p, bp, Nospace );
  341.         return -1;
  342.     }
  343.  
  344.     /* Load header with proper values */
  345.     cp = hbp->data;
  346.     if ( full_ac ) {
  347.         *cp++ = hdr.addr;
  348.         *cp++ = hdr.control;
  349.     }
  350.     if ( full_p )
  351.         *cp++ = (hdr.protocol >> 8);
  352.     *cp++ = (hdr.protocol & 0x00ff);
  353.  
  354.     /* Allocate output mbuf that's twice as long as the packet.
  355.      * This is a worst-case guess (consider a packet full of HDLC_FLAGs!)
  356.      */
  357.     if ((bp = alloc_mbuf((int16)(2*len_p(hbp) + HDLC_ENVLEN))) == NULLBUF) {
  358.         ppp_out_error( ppp_p, hbp, Nospace );
  359.         return -1;
  360.     }
  361.     cp = bp->data;
  362.  
  363.     /* No need to send an opening flag if the previous packet is still
  364.      * being transmitted.
  365.      */
  366.     if ( Asy[iface->dev].dma.flags == 0 ) {
  367.         /* Flush out any line garbage */
  368.         *cp++ = HDLC_FLAG;
  369.         ppp_p->OutOpenFlag++;
  370.     }
  371.  
  372.     /* Copy input to output, escaping special characters */
  373.     while ((c = PULLCHAR(&hbp)) != -1) {
  374.         /* Fold char value into FCS calculated so far */
  375.         calc_fcs = pppfcs(calc_fcs, c);
  376.  
  377.         if ( ((c < SP_CHAR) && (accm & (1L << c)))
  378.             || (c == HDLC_ESC_ASYNC)
  379.             || (c == HDLC_FLAG)) {
  380.             *cp++ = HDLC_ESC_ASYNC;
  381.             *cp++ = (c ^ HDLC_ESC_COMPL);
  382.         } else {
  383.             *cp++ = c;
  384.         }
  385.     }
  386.  
  387.     /* Final FCS calculation */
  388.     calc_fcs ^= 0xffff;
  389.     c = (calc_fcs & 0x00ff);    /* Least significant byte first */
  390.     if ( ((c < SP_CHAR) && (accm & (1L << c)))
  391.          ||(c == HDLC_ESC_ASYNC)
  392.          ||(c == HDLC_FLAG)) {
  393.         *cp++ = HDLC_ESC_ASYNC;
  394.         *cp++ = (c ^ HDLC_ESC_COMPL);
  395.     } else {
  396.         *cp++ = c;
  397.     }
  398.     c = (calc_fcs >> 8);        /* Most significant byte next */
  399.     if ( ((c < SP_CHAR) && (accm & (1L << c)))
  400.          ||(c == HDLC_ESC_ASYNC)
  401.          ||(c == HDLC_FLAG)) {
  402.         *cp++ = HDLC_ESC_ASYNC;
  403.         *cp++ = (c ^ HDLC_ESC_COMPL);
  404.     } else {
  405.         *cp++ = c;
  406.     }
  407.  
  408.     /* Tie off the packet */
  409.     *cp++ = HDLC_FLAG;
  410.     bp->cnt = cp - bp->data;
  411.  
  412.     if (iface->trace & IF_TRACE_RAW)
  413.         raw_dump(iface,IF_TRACE_OUT,bp);
  414.     ppp_p->OutTxPacketCount++;
  415.     return asy_send(iface->dev,bp);
  416. }
  417.  
  418.  
  419. /****************************************************************************/
  420. /* Queue packet for ppp_proc with full header */
  421. /* (part of ppp_recv) */
  422. static void
  423. ppp_queue(ppp_p,bp,negotiated)
  424. struct ppp_s *ppp_p;
  425. struct mbuf *bp;
  426. int16 negotiated;
  427. {
  428.     struct ppp_hdr hdr;
  429.     struct mbuf *hbp;
  430.  
  431.     /* HDLC address and control fields may be compressed out */
  432.     if ((byte_t)bp->data[0] != HDLC_ALL_ADDR) {
  433.         if (!(negotiated & LCP_N_ACFC)) {
  434.             ppp_unknown( ppp_p, bp, "missing ALL address" );
  435.             return;
  436.         }
  437.     } else if ((byte_t)bp->data[1] != HDLC_UI) {
  438.         if (!(negotiated & LCP_N_ACFC)
  439.          || !(negotiated & LCP_N_PFC)) {
  440.             ppp_unknown( ppp_p, bp, "missing UI" );
  441.             return;
  442.         }
  443.     } else {
  444.         /* skip address/control fields */
  445.         pull16(&bp);
  446.     }
  447.  
  448.     /* Initialize the expected header */
  449.     hdr.addr = HDLC_ALL_ADDR;
  450.     hdr.control = HDLC_UI;
  451.     hdr.protocol = PULLCHAR(&bp);
  452.  
  453.     /* First byte of PPP protocol field may be compressed out */
  454.     if ( hdr.protocol & 0x01 ) {
  455.         if (!(negotiated & LCP_N_PFC)) {
  456.             ppp_unknown( ppp_p, bp, "missing upper protocol byte" );
  457.             return;
  458.         }
  459.     } else {
  460.         hdr.protocol = (hdr.protocol << 8) | PULLCHAR(&bp);
  461.  
  462.         /* Second byte of PPP protocol field must be odd */
  463.         if ( !(hdr.protocol & 0x01) ) {
  464.             ppp_unknown( ppp_p, bp, "missing lower protocol byte" );
  465.             return;
  466.         }
  467.     }
  468.  
  469.     /* put full-size header on packet for dump routine */
  470.     if ((hbp = htonppp(&hdr,bp)) == NULLBUF){
  471.         ppp_unknown( ppp_p, bp, Nospace );
  472.         return;
  473.     }
  474.  
  475.     if ( net_route( ppp_p->iface, CL_PPP, hbp ) != 0 ) {
  476.         ppp_unknown( ppp_p, hbp, Nospace );
  477.     }
  478. }
  479.  
  480.  
  481. /* Packetize PPP input from device */
  482. /* (process started by ppp_init) */
  483. void
  484. ppp_recv(dev,p1,p2)
  485. int dev;
  486. void *p1;
  487. void *p2;
  488. {
  489.     struct iface *ifp = p1;
  490.     struct ppp_s *ppp_p = ifp->extension;
  491.     int16 negotiated = FALSE;
  492.     int32 accm = LCP_ACCM_DEFAULT;
  493.     int16 calc_fcs = HDLC_FCS_START;
  494.     struct mbuf *raw_bp = NULLBUF;
  495.     struct mbuf *head_bp = NULLBUF;
  496.     register struct mbuf *tail_bp = NULLBUF;
  497.     char *cp;            /* next byte in tail mbuf */
  498.     register int mode = modeTOSS;
  499.     register int c;
  500.  
  501.     while ( (c = get_asy(dev)) != -1 ) {
  502. #ifdef PPP_DEBUG_RAW
  503.         if (ifp->trace & IF_TRACE_RAW) {
  504.             if ( raw_bp != NULLBUF
  505.               || (raw_bp = alloc_mbuf( LCP_MRU_HI * 2 )) != NULLBUF ) {
  506.                 *raw_bp->data++ = c;
  507.                 raw_bp->cnt++;
  508.                 if ( raw_bp->cnt != 1 && c == HDLC_FLAG ) {
  509.                     raw_bp->data = (char *)(raw_bp + 1);
  510.                     raw_dump( ifp, IF_TRACE_IN, raw_bp );
  511.                     raw_bp->cnt = 0;
  512.                 }
  513.             }
  514.         }
  515. #endif
  516.         if ( c == HDLC_FLAG ) {
  517.             if (mode == modeESCAPED) {
  518.                 ppp_unknown( ppp_p, head_bp, "deliberate cancellation" );
  519.             } else if ( head_bp != NULLBUF ) {
  520.                 if ( calc_fcs != HDLC_FCS_FINAL ) {
  521.                     ppp_unknown( ppp_p, head_bp, "checksum error" );
  522.                     ppp_p->InChecksum++;
  523.                 } else {
  524.                     ppp_queue(ppp_p, head_bp, negotiated);
  525.                 }
  526.             } else {
  527.                 ppp_p->InOpenFlag++;
  528.             }
  529.  
  530.             /* setup for next buffer */
  531.             mode = modeNORMAL;
  532.             head_bp = tail_bp = NULLBUF;
  533.             calc_fcs = HDLC_FCS_START;
  534.             accm = LCP_ACCM_DEFAULT;
  535.  
  536.             /* Use negotiated values if LCP finished */
  537.             if (ppp_p->fsm[Lcp].state == fsmOPENED) {
  538.                 struct lcp_s *lcp_p = ppp_p->fsm[Lcp].pdv;
  539.  
  540.                 negotiated = lcp_p->local.work.negotiate;
  541.                 if (negotiated & LCP_N_ACCM) {
  542.                     accm = lcp_p->local.work.accm;
  543.                 }
  544.             }
  545. #ifdef PPP_DEBUG_RAW
  546.             if (!(ifp->trace & IF_TRACE_RAW)) {
  547.                 if ( raw_bp != NULLBUF ) {
  548.                     free_p( raw_bp );
  549.                     raw_bp = NULLBUF;
  550.                 }
  551.             }
  552. #endif
  553.             continue;
  554.         }
  555.  
  556.         /* We reach here for every byte inside a frame.
  557.          * (The order of the following tests is important.)
  558.          * Check for discard.
  559.          * Discard spurious control characters.
  560.          * Check for escape sequence.
  561.          * (Allow escaped escape.)
  562.          */
  563.         if ( mode == modeTOSS ) {
  564.             continue;
  565.         } else if ( c < SP_CHAR && (accm & (1L << c)) ) {
  566.             continue;
  567.         } else if ( mode == modeESCAPED ) {
  568.             mode = modeNORMAL;
  569.             c ^= HDLC_ESC_COMPL;
  570.         } else if ( c == HDLC_ESC_ASYNC ) {
  571.             mode = modeESCAPED;
  572.             continue;
  573.         }
  574.  
  575.         /* We reach here with a byte for the buffer.
  576.          * Make sure there is room for it.
  577.          */
  578.         if ( tail_bp == NULLBUF ) {
  579.             if ((tail_bp = alloc_mbuf(PPP_ALLOC)) == NULLBUF) {
  580.                 ppp_unknown( ppp_p, tail_bp, Nospace );
  581.                 mode = modeTOSS;
  582.                 continue;
  583.             }
  584.             head_bp = tail_bp;
  585.             cp = tail_bp->data;
  586.         } else if ( tail_bp->cnt >= tail_bp->size ) {
  587.             /* Current mbuf is full */
  588.             if ( (tail_bp->next = alloc_mbuf(PPP_ALLOC)) == NULLBUF ) {
  589.                 /* No memory, drop the whole packet */
  590.                 ppp_unknown( ppp_p, head_bp, Nospace );
  591.                 head_bp = NULLBUF;
  592.                 mode = modeTOSS;
  593.                 continue;
  594.             }
  595.             tail_bp = tail_bp->next;
  596.             cp = tail_bp->data;
  597.         }
  598.  
  599.         /* Store the byte, increment counts */
  600.         *cp++ = c;
  601.         tail_bp->cnt++;
  602.         calc_fcs = pppfcs(calc_fcs, c);
  603.     }
  604.  
  605.     /* clean up afterward */
  606.     free_p(raw_bp);
  607.     free_p(head_bp);
  608.     ifp->rxproc = NULLPROC;
  609. }
  610.  
  611. /*#pragma option -G-*/
  612. /* Process incoming PPP packets */
  613. /* (called from network task) */
  614. void
  615. ppp_proc(iface,bp)
  616. struct iface *iface;
  617. struct mbuf *bp;
  618. {
  619.     struct ppp_s *ppp_p = iface->extension;
  620.     struct ipcp_s *ipcp_p;
  621.     struct ppp_hdr hdr;
  622.     struct mbuf *hbp;
  623.  
  624.     if ( bp == NULLBUF )
  625.         return;
  626.  
  627.     ppp_p->InRxPacketCount++;
  628.  
  629.     /* get PPP header */
  630.     ntohppp(&hdr, &bp);
  631.  
  632.     /* trim off FCS bytes */
  633.     trim_mbuf(&bp, len_p(bp)-2);
  634.  
  635.     switch(hdr.protocol) {
  636.     case PPP_IP_PROTOCOL:    /* Regular IP */
  637.         if ( ppp_p->fsm[IPcp].state != fsmOPENED ) {
  638.             ppp_in_error( ppp_p, bp, "not open for IP traffic" );
  639.             break;
  640.         }
  641.         ppp_p->InIP++;
  642.         ip_route(iface,bp,0);
  643.         break;
  644.  
  645.     case PPP_COMPR_PROTOCOL:    /* Van Jacobson Compressed TCP/IP */
  646.         if ( ppp_p->fsm[IPcp].state != fsmOPENED ) {
  647.             ppp_unknown( ppp_p, bp, "not open for Compressed TCP/IP traffic" );
  648.             break;
  649.         }
  650.  
  651.         ipcp_p = ppp_p->fsm[IPcp].pdv;
  652.         if (!(ipcp_p->local.work.negotiate & IPCP_N_COMPRESS)) {
  653.             ppp_unknown( ppp_p, bp, "Compressed TCP/IP not enabled" );
  654.             break;
  655.         }
  656.  
  657.         if ( slhc_uncompress(ipcp_p->slhcp, &bp) <= 0 ) {
  658.             ppp_in_error( ppp_p, bp, "Compressed TCP/IP packet error" );
  659.             break;
  660.         }
  661.         ppp_p->InIP++;
  662.         ip_route(iface,bp,0);
  663.         break;
  664.  
  665.     case PPP_UNCOMP_PROTOCOL:    /* Van Jacobson Uncompressed TCP/IP */
  666.         if ( ppp_p->fsm[IPcp].state != fsmOPENED ) {
  667.             ppp_unknown( ppp_p, bp, "not open for Uncompressed TCP/IP traffic" );
  668.             break;
  669.         }
  670.  
  671.         ipcp_p = ppp_p->fsm[IPcp].pdv;
  672.         if (!(ipcp_p->local.work.negotiate & IPCP_N_COMPRESS)) {
  673.             ppp_unknown( ppp_p, bp, "Uncompressed TCP/IP not enabled" );
  674.             break;
  675.         }
  676.  
  677.         if ( slhc_remember(ipcp_p->slhcp, &bp) <= 0 ) {
  678.             ppp_in_error( ppp_p, bp, "Uncompressed TCP/IP packet error" );
  679.             break;
  680.         }
  681.         ppp_p->InIP++;
  682.         ip_route(iface,bp,0);
  683.         break;
  684.  
  685.     case PPP_LCP_PROTOCOL:    /* Link Control Protocol */
  686.         ppp_p->InNCP[Lcp]++;
  687.         fsm_proc(&(ppp_p->fsm[Lcp]),bp);
  688.         break;
  689.  
  690.     case PPP_PAP_PROTOCOL:    /* Password Authenticate Protocol */
  691.         if (ppp_p->phase != pppAP) {
  692.             ppp_in_error( ppp_p, bp, "not in Authentication phase;"
  693.                     " dropping PAP packet" );
  694.             break;
  695.         }
  696.         ppp_p->InNCP[Pap]++;
  697.         pap_proc(&(ppp_p->fsm[Pap]),bp);
  698.         break;
  699.  
  700.     case PPP_IPCP_PROTOCOL:    /* IP Control Protocol */
  701.         if (ppp_p->phase < pppREADY) {
  702.             ppp_in_error( ppp_p, bp, "not ready for IPCP traffic" );
  703.             break;
  704.         }
  705.         ppp_p->InNCP[IPcp]++;
  706.         fsm_proc(&(ppp_p->fsm[IPcp]),bp);
  707.         break;
  708.  
  709.     default:
  710.         if ( ppp_p->trace )
  711.             log( -1, "%s: PPP Unknown packet protocol: %x;",
  712.                 ppp_p->iface->name,
  713.                 hdr.protocol);
  714.         ppp_p->InUnknown++;
  715.  
  716.         /* Build Protocol Reject packet:
  717.          * put the header back on ...
  718.          */
  719.         if ((hbp = htonppp(&hdr,bp)) == NULLBUF){
  720.             ppp_log( ppp_p, Nospace );
  721.             free_p(bp);
  722.             return;
  723.         }
  724.         /* ... then pull off the address and control fields ... */
  725.         pull16(&hbp);
  726.         /* ... and send it as an LCP packet */
  727.         fsm_send( &(ppp_p->fsm[Lcp]), PROT_REJ, 0, hbp );
  728.         break;
  729.     };
  730. }
  731. /*#pragma option -G */
  732.  
  733. /****************************************************************************/
  734.  
  735. /* Keep track of changes in I-O status */
  736. /* (called through iface iostatus vector) */
  737. static int
  738. ppp_iostatus( ifp, command, value )
  739. struct iface *ifp;
  740. int command;
  741. int32 value;
  742. {
  743.     struct ppp_s *ppp_p = ifp->extension;
  744.  
  745.     switch ( command ) {
  746.     case PARAM_UP:
  747.         ppp_log( ppp_p, "Physical layer up" );
  748.  
  749.         ppp_p->phase = pppLCP;
  750.         psignal(ppp_p, 0);
  751.         return 0;
  752.     case PARAM_DOWN:
  753.         ppp_log( ppp_p, "Physical layer down" );
  754.  
  755.         fsm_down( &(ppp_p->fsm[Lcp]) );
  756.  
  757.         /* This point is a little tricky.
  758.          * If LCP was OPEN, it has just set the phase
  759.          * to TERMINATE.  But we don't want to terminate
  760.          * if a dialer is able to bring us up again.
  761.          * Otherwise, we got here because of TERMINATE.
  762.          * In either case, we change TERMINATE to DEAD.
  763.          */
  764.         ppp_p->phase = pppDEAD;
  765.         psignal(ppp_p, 0);
  766.         return 0;
  767.     };
  768.     return -1;
  769. }
  770.  
  771.  
  772.  
  773. /****************************************************************************/
  774. /* PPP Overall Phase Machine
  775.  *
  776.  *    This machine is controlled by the pwait & psignal at ppp_p,
  777.  *    whenever the overall link phase (as opposed to the LCP state) changes.
  778.  */
  779. void
  780. ppp_machine(dev,p1,p2)
  781. int dev;
  782. void *p1;
  783. void *p2;
  784. {
  785.     struct iface *ifp = p1;
  786.     struct ppp_s *ppp_p = ifp->extension;
  787.     struct lcp_s *lcp_p;
  788.  
  789.     for (;;) {
  790.         switch ( ppp_p->phase ) {
  791.         case pppDEAD:
  792.             pwait(ppp_p);
  793.             break;
  794.  
  795.         case pppLCP:        /* When Physical Line Up */
  796.                     /* or Open command */
  797.             fsm_start( &(ppp_p->fsm[Lcp]) );
  798.             pwait(ppp_p);
  799.             break;
  800.  
  801.         case pppAP:        /* When LCP complete */
  802.             lcp_p = ppp_p->fsm[Lcp].pdv;
  803.             if (lcp_p->local.work.negotiate & LCP_N_AUTHENT) {
  804.                 ppp_p->flags |= PPP_AP_LOCAL;
  805.                 pap_local(ppp_p);
  806.             }
  807.             if (lcp_p->remote.work.negotiate & LCP_N_AUTHENT) {
  808.                 ppp_p->flags |= PPP_AP_REMOTE;
  809.                 if (pap_remote(ppp_p) != 0) {
  810.                     ppp_p->phase = pppTERMINATE;
  811.                     break;
  812.                 }
  813.             }
  814.             if (ppp_p->flags & (PPP_AP_LOCAL | PPP_AP_REMOTE)) {
  815.                 pwait(ppp_p);
  816.                 psignal( ppp_p->fsm[Pap].pdv, 0 );
  817.             } else {
  818.                 ppp_p->phase = pppREADY;
  819.                 /* no waiting */
  820.             }
  821.             break;
  822.  
  823.         case pppREADY:        /* When no authentication */
  824.                     /* or AP authentication success */
  825.             ppp_p->upsince = time(0L);
  826.             fsm_start( &(ppp_p->fsm[IPcp]) );
  827.             pwait(ppp_p);
  828.             break;
  829.  
  830.         case pppTERMINATE:    /* When LCP terminating */
  831.                     /* or AP authentication failure */
  832.             /* Tell the dialer to shut down */
  833.             if ( ifp->supv != NULLPROC )
  834.                 alert( ifp->supv, EABORT );
  835.  
  836.             /* Close the link, if it isn't already */
  837.             fsm_close( &(ppp_p->fsm[Lcp]) );
  838.             ppp_p->phase = pppDEAD;
  839.             break;
  840.         };
  841.     }
  842. }
  843.  
  844.  
  845. /****************************************************************************/
  846. /* Initialize PPP control structures for a Point-to-Point interface */
  847. int
  848. ppp_init(ifp)
  849. struct iface *ifp;
  850. {
  851.     struct ppp_s *ppp_p;
  852.     char *ifn;
  853.  
  854.     if ((ppp_p = callocw(1,sizeof(struct ppp_s))) == NULL)
  855.         return -1;
  856.  
  857.     ifp->extension = ppp_p;
  858.     ifp->iostatus = ppp_iostatus;
  859.     ifp->raw = ppp_raw;
  860.     ifp->status = ppp_status;
  861.     ifp->echo = ppp_echo;
  862.     ifp->discard = ppp_discard;
  863.  
  864.     ppp_p->iface = ifp;
  865.     ppp_p->phase = pppDEAD;
  866.  
  867.     ppp_p->machine = newproc( ifn = if_name( ifp, " machine" ),
  868.             512, ppp_machine, ifp->dev, ifp, NULL, 0);
  869.     free(ifn);
  870.     pwait(NULL);    /* give machine a chance to run */
  871.  
  872.     ifp->rxproc = newproc( ifn = if_name( ifp, " receive" ),
  873.             320, ppp_recv, ifp->dev, ifp, NULL, 0);
  874.     free(ifn);
  875.     return 0;
  876. }
  877.  
  878.  
  879. int
  880. ppp_free(ifp)
  881. struct iface *ifp;
  882. {
  883.     struct ppp_s *ppp_p = ifp->extension;
  884.     int fsmi;
  885.  
  886.     alert( ifp->rxproc, -1 );
  887.     killproc( ppp_p->machine );
  888.  
  889.     for ( fsmi = Lcp; fsmi < fsmi_Size; ) {
  890.         fsm_free( &(ppp_p->fsm[fsmi++]) );
  891.     }
  892.     free( ppp_p );
  893.     return 0;
  894. }
  895.  
  896.